Efficient Trajectory Repairing For Autonomous Vehicles - Evaluation